
ROBOTIC CONTROL OF THE SEVEN-DEGREE-OF-FREEDOM 
NASA LABORATORY TELEROBOTIC MANIPULATOR* 

R. V. Dubey, J. A. Euler and R. B. Magness 
Mechanical & Aerospace Engineering 
The University of Tennessee 
Knoxville, Tennessee 37996 

S. M. Babcock and J. N. Hemdon 
Oak Ridge National Laboratory 
Oak Ridge, Tennessee 37831 


ABSTRACT 

A computationally efficient robotic control scheme for the NASA Laboratory Telerobotic Manipulator (LTM) is 
presented. This scheme utilizes the redundancy of the seven-degree-of-freedom LTM to avoid joint limits and 
singularities. An analysis to determine singular configurations is presented. Performance catena are determined based 
on die joint limits and singularity analysis. The control scheme is developed in the framework of resolved rate control 
using the gradient projection method, and it does not require the generalized inverse of the Jacobian. An efficient 
formulation for determining the joint velocities of the LTM is obtained. This control scheme is well suited for real- 
time implementation, which is essential if the end-effector trajectory is continuously modified based on sensory 
feedback. Implementation of this scheme on a Motorola 68020 VME bus-based controller of the LTM is in progress. 
Simulation results demonstrating the redundancy utilization in the robotic mode are presented. 


1. Introduction 

NASA has embarked on an extensive national project to establish a permanent human-occupied space station. To 
accomplish this project, significantly increased levels of dexterous human-like handling tasks will be required in orbit. 
This will include space station construction as well as planned and unplanned maintenance operations on the station. In 
addition, a significant amount of satellite repair and maintenance is expected in the future. To meet the need for sharply 
increased levels of dexterous handling while decreasing the levels of required human extravehicular activity, NASA has 
established a goal for significant use of telerobotic hardware in future space activities. 

The NASA Langley Research Center has sponsored the Laboratory Telerobotic Manipulator (LTM) Prototype 
Project at the Oak Ridge National Laboratory to develop prototypical manipulators for use in NASA laboratories to 
develop and demonstrate telerobotic and robotic capabilities in an earth-based environment [1]. As a result, the LTM 
must be designed to be a high-quality force-reflecting teleoperator with capabilities for robotic operation. High 
performance under human control, low required backdriving torque, high velocity and acceleration capability, and good 
capacity-to- weight ratio are emphasized in the design. To provide the basis for a transition to autonomous robotic 
operation, features for high-quality robotic operation are also provided. These include good end-effector positioning 
accuracy and high mechanical and control stiffness. The LTM is also designed for modular maintainability to ease re- 
pair and reconfiguration. 

The LTM arm, shown in Fig. 1, has seven degrees of freedom that provide kinematic redundancy. The arm is 
configured from three common pitch/yaw joints which combine to provide shoulder, elbow, and wrist joints. The 

♦Research performed at Oak Ridge National Laboratory, operated by Martin Marietta Energy Systems, Inc., for the 
U.S. Department of Energy under Contract No. DE-AC05-840R21400, and sponsored by the National Aeronautics and 
Space Administration, Langley Research Center. 
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MflliQD 

Shoulder pitch 
Shoulder yaw 
Elbow pitch 
Elbow yaw 
Wrist pitch 
Wrist yaw 
Wrist roll 


Table 2. Motion Range of the LTM 
(Note; Zero reference is indicated in Figure 1) 


Range (degrees) with 
counterbalancing and 
with cabling. 


Range (degrees) with- 
out counterbalancing 
and with cabling , 


-45>©! >-135 
+ 180>© 2 >-180 
+120 > ©3 > +45 
+ 120 > 0 4 > -120 
+ 135 > ©5 > -30 
+ 180 > 0 6 > 0 
+ 180 > 0 7 > -180 


+30 >0j >-135 
+ 180 > 0 2 > -1 80 
+ 135 > 03 > -30 
+ 180 > 0 4 >-180 
+ 135 > ©5 > -30 
+ 180 > 0 6 > 0 
+ 180 > 0 7 > -180 


interface boundaries of these joints provide inherent modularity. A wrist roll mechanism, mounted on the output of 
the wrist joint, provides the seventh degree of freedom. Seven degrees of freedom allow the LTM to reorient itself 
without changing the end-effector position and orientation. This paper describes the robotic control scheme for the 
LTM for utilizing redundancy to avoid internal singularities and joint limits. 

2. Robotic Control of the LTM 

Several joints of a robotic manipulator at time-varying rates simultaneously move the end-effector along a specified 
path defined in terms of end-effector position and orientation as a function of time. In the case of a six-degree-of- 
freedom manipulator, joint motions required to achieve a specified end-effector motion are unique. However, a seven-or 
more degree-of-freedom manipulator has more joints than the six independent variables required to completely specify 
the position and orientation of the end-effector. The kinematic linear equations relating unknown joint velocities to 
specified end-effector velocity components do not have unique solutions-an infinite number of solutions is possible. 
Thus we may choose a joint velocity solution that results in "improved" performance of the manipulator while tracking 
a desired trajectory, and performance may be judged by criteria such as avoiding obstacles or joint limits. 

A number of control schemes for determining joint trajectories for redundant manipulators have been suggested by 
researchers. Most control schemes in the literature determine joint velocities through global or local optimization of 
various performance criteria. Global optimization schemes are generally iterative and computationally complex; thus, 
they are currently limited to off-line programming. On-line implementation is essential if the end-effector trajectory is 
continuously modified based on sensory feedback. Most local optimization schemes are presented in the framework of 
resolved rate control [2]. Control of the LTM in the robotic mode is achieved by an efficient gradient projection 
kinematic control scheme developed by Dubey et al. [3]. This scheme avoids computation of the pseudoinverse of the 
Jacobian, and it results in an efficient formulation for determining joint velocities. 
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3. Kinematic Optimization Scheme 

The kinematic optimization scheme developed by Dubey et al. [3] used to control the LTM can be summarized as 
follows. A manipulator using n joints to control m independent variables of the end-effector position and orientation 
(m < 6) is described by the following kinematic equation: 

x = j6 , 0) 

where x is an m-dimensional vector of linear and angular velocities of the end-effector with reference to base 
coordinates, 0 is an n-dimensional vector of joint velocities, and J is an m x n Jacobian matrix. 


If j is a square matrix and has full rank, then the joint velocities required to achieve the desired end-effector motion 
will be unique and can be evaluated by 

6 = r l k . ( 2 ) 

If J is rectangular with m < n, the joint velocities can be computed by 

& = j + x + a - J + JW . (3) 

where J + is the Moore-Penrose generalized inverse [4] of the Jacobian. If J has a full rank , then 

J + = J T (JJ T )' 1 . W 

The matrix I in Eq. (3) is an n x n identity matrix, and the vector $ is an arbitrary n-dimensional joint velocity vector. 
To optimize a performance criterion H(0) using the gradient projection method [5], redundancy is resolved by 
substituting kVH(0) for 4> in Eq. (3) and rewriting it as 

0 = J + x + k(I - J + J)VH(0). (5) 

The coefficient k in Eq. (5) is a real scalar constant, and VH(0) is the gradient vector of H(0). 

Let 0 e be the joint velocity vector for the seven-degree-of-freedom manipulator. Suppose in the Cartesian 
workspace the end-effector velocity is described by a six-dimensional vector with reference to the base coordinates, and 
has three linear and three angular velocity components. The joint velocity vector 0 and the end-effector velocity vector 
x are related by Eq. (1), where J is a 6 x 7 Jacobian matrix. We will assume that the rank of the Jacobian is six, 
which implies that J is not singular. Thus, it is possible to construct a nonsingular 6x6 matrix J from any six 
independent columns of the matrix. In general, by rearranging the columns of J and the corresponding elements of 0 
in a different order, we can rewrite Eq. (1) as 

x = [a J*]0 , (6) 

where a is any column vector of the Jacobian such that the remaining six columns form a nonsingular matrix J . 
Rearranging terms in Eq. (5), we obtain the following: 

0 = J + (x - kjVH) + kVH . (7) 

A suitable selection of k may be based on the hardware bounds on the joint velocities and heuristics. The first term on 
the right-hand side of Eq. (7) is the least-norm solution of Eq. (1) with x replaced by (x - kj VH). As shown in ref.3, 
the least-norm solution can be obtained from a particular solution (L and a homogeneous solution 0^ of this equation 
by subtracting from the particular solution its component along the homogeneous solution. Thus we have 
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where 


ft* - 
9 P " 

and 

e* h = [ f \ J . 00) 

If we assume the wrist to be spherical, with none of the two wrist axes pairs aligned, we can partition J* as 
follows: 


*- 1 . 

J (x- kJVH) 


» 

i 


(9) 


J 


* 


j*3x3 q3x3 
j*3x3 j^3x3 _ ' 


( 11 ) 


*-l . *-l 

To determine J (x- kJVH) and J a in Eqs. (9) and (10) respectively, we need only to solve two sets of three 
simultaneous equations. Thus a simple formulation for determining the joint velocities is obtained. 


4. Inverse Kinematics of the LTM 


The above control scheme for optimizing a performance criterion using the gradient projection method was applied 
to the LTM. The LTM is a seven degree-of-freedom manipulator with a spherical wrist. The pitch-yaw-roll spherical 
wrist is designed so that its singularities occur when the hand is pointing to its sides and at the extremes of motion 
range, not when it is pointing straight out, as is common in many industrial manipulators. Degrees of freedom of the 
LTM and the coordinate frames referred to in the Denavit-Hartenberg table (Table 1) for this manipulator are shown in 
Fig.l. 

To simplify the calculations, we will refer the desired end-effector and wrist velocity vectors to the third coordinate 
frame *3^3,23, which is attached to link 3 using the notation used by Paul [6], This results in a Jacobian that has a 
much simpler form and thus is more efficient for computation. Let the desired end-effector velocity referred to the third 
coordinate frame be given by 


3x h = [ 3 i 


a T ,t 
3<0 h ] 


3 *h = [ 3 v hj 3v h2 3y h3 3^^ 3^ 


( 12 ) 


where 3 Vh e R 3 and 3 (0h e R 3 are the linear and angular hand velocity vectors, respectively, referred to the third 
coordinate frame. 


Let the desired wrist velocity vector referred to the third coordinate frame be given by 


3 v = t 


5x w 


Wi 


Wo 


w 


W' 


'i T _t 
1 

w J 


3(o 


Wi 


5 CD 


w- 


3 “wJ T . 


(13) 


where 3 v w e R-* and 3 co w e R 3 are the linear and angular wrist velocity vectors, respectively, referred to the third 
coordinate frame. For a given 3%^ , the terms of 3% w may be obtained by using the following relationships: 

3 (0 W = , (14) 
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3 v w = 3 v h - 3 ©h Xd7 3 zh. ( 15 ) 

where 3 z h is the unit vector z h at the hand (Fig. 1) that is referred to the third coordinate frame; 3 z h may be shown to 
be the following: 


3 z h = [s4 c 6 +c 4 c 5 s 6 s 4 c 5 s 6' c 4 c 6 " s 5 s 6] T • (16) 

where cj and Sj represent cos0, and sin0j respectively. Let 3 J W be the Jacobian relating the joint velocity vector 0 = 
[0j ,0^ j’L and the wrist velocity vector 3 x w such that 


The Jacobian 3 J W can be shown to be the following: 


a 4 s 2 s 3 s 4 +a 2 c 2 s 3 

44 C 3 S 4 

-34 S 2 S 3 C 4 

-a4C 3 c 4 -a2 

-a4(s 2 C3S4+C2 c 4)' a 2 c 2 c 3 

34 S 3 S 4 

" S 2 C 3 

s 3 

c 2 

0 

* S 2 S 3 

<3 


3 J w d. 07) 


0 

-8484 

0 

0 

0 

0 

3404 

0 

0 

0 

-8404 

0 

0 

0 

0 

0 

0 

-s 4 

c 4 s 5 

C 4 C 5 S 6 +S 4 C 6 

1 

0 

c 4 

s 4 s 5 

S 4 C 5 S 6' C 4 C 6 

0 

1 

0 

c 5 

-S5S6 


where, as before, cj and s, represent cos0j and sin0j respectively. 

To determine the joint velocities required to follow a desired end-effector velocity and to optimize a given 
performance criterion using the gradient projection method, we first determine the end-effector velocity 3 x h referred to 
the third coordinate frame. Given the end-effector velocity vector xjj e R 6 in the base coordinates, we can determine 
3 xj, from the following: 


3 *h = 3 Ro*h . 


(19) 


where 3 Rq is a 3 x 3 projection matrix given by 


C 1 C 2 C 3‘ S 1 S 3 

S 1 C 2 C 3 +C 1 S 3 

' S 2 C 3 

c l s 2 

s l s 2 

c 2 

. c 1 c 2 S3+s 1 C3 

S 1 C 2 S 3' C 1 C 3 

-S2 S 3 . 


( 20 ) 


and q and sj represent cos0j and sin0j respectively. We can now determine wrist velocity vector 3 x w from Eqs. (14) 
and (15). 


Consider the case when the first column of the Jacobian is taken to be a and the remaining six columns are 
independent and form the matrix J*. The elements of (jj, denoted by , for i = 1 to 7, with = 0, may be obtained 
as follows: 




3404 

84 S4 


*1 

1 

•CD 

1 

A 

. 32+840304 

a 4 c 3 s 4 . 


.*2. 


(21a) 
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where A 


- a 2 a 4 s 4 , 


_ (a4S 3 s 4 )^ 2 - x 3 
P 3 - 8404 


(22a) 


0* 


A* 

_ i _ 

^6 

S6 

1 — 

-j 



C 4 C 5 C 6' S 4 S 6 

S4 C 5 C 6 +C 4 S 6 

" S 5 C 6 “ 


*4 ~ s 3®P2 

C 4 S 5 S 6 

S 4 S 5S6 

c 5*6 


x 5 ~ ®p 3 

c 4 c 5 

54C5 

" s 5 - 


_ x 6 + c 3^p 2 “ ^>4 - 


• ( 23 a) 


On the other hand, another column, say column four, may be taken to be a with the remaining six columns 
forming the matrix J*. in which case if J* is nonsingular we have (£ 4 = 0 and : 


A. 



-(a 2 +a 4 c 3 c 4 ) 

-a 4 C 3 s 4 


“ - 

1 



X 1 

A 

a 4 S 2 S 3 c 4 

a 4 S 2 S 3 s 4 +a 2 C 2 S 3 _ 


. x 2 _ 


where A = -3283(34020304 + a4S2S4 + a2C2), 



(a4S 3 S4)^ 2 


X3 - [a4(S2C 3 s 4 + C2C4) + &2 C 2 C 3^% X 
a 4C4 


(21b) 


(22b) 


and 


1 

1 


c 4 c 5 c 6-s 4 S6 

S 4 C 5 C 6 +C 4 S 6 



*4 + s 2*3$ 1 ~ s 3$2 

?6 

II 

C4 S 5S6 

S 4 S 5 S 6 

c 5*6 


x 5" c 2^! -$ 3 



C 4 C 5 

S 4 C 5 

' s 5 - 


_x 6 + s 2 s 3^pi + c 3^2 - 


In Eqs. ( 21 ) through ( 23 ), Xj for i = 1 to 6 are the i th elements of the vector (it - kJVH). The vector 0 fj with 
elements e£.,i = 1 to 7, may similarly be obtained by setting the element 0^ . = 1, where i = 1 for the case 
when a is talcen to be the first column and i = 4 when a is taken to be the fourth column. The remaining elements of 
e£ may be obtained from Eqs. ( 21 ) through ( 23 ) by replacing 0 p . by ©h t and using Ae ith elements of vector -a for 
x* for i = 1 to 6. 

We have obtained computationally efficient closed- form solutions for the elements of ^ and 0 ^ in Eqs. ( 21 ) 
through ( 23 ). The vector 0 can now be obtained from Eq. (8). Thus, by this approach we have eliminated the need to 
determine the generalized inverse of the Jacobian or to numerically solve the six simultaneous equations with six 
unknowns. Suppose that in the course of execution we have S4 approaching zero, then a may be chosen to be equal to 
column 4 . On the other hand, if S3 approaches zero we may choose a to be column 1 . In all cases, C4 = 0 and/or S5 
= 0 must be avoided, situations achieved by optimizing a suitable performance criterion. 
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5. Performance Criteria and Singularity Analysis 

To avoid joint limits and singular configurations of the LTM we have developed performance criteria to be 
optimized using the control scheme presented in the last section. The motion ranges of the joints of the LTM, given 
in Table 2, are given for two cases: (1) with counter-balancing and cabling and (2) without counter-balancing and with 
cabling (see Fig.l). To stay within the joint limits specified in Table 2, we may choose the following performance 
criterion: 

H( 0 ) = i(e i -e imid ) 2 , (24) 

where 0j is the i th joint angle and 0j mid is the midpoint value for the 0, joint angle. Inspection of the above 
performance criterion shows that if it is minimized, the joint angles tend to stay in their midrange. Each term in the 
above summation may be weighted according to the range of the corresponding joint motion and its distance from the 
midpoint. 

When a manipulator is in a singular configuration it is unable to move or rotate the end-effector in at least one 
direction. The joint velocities required to move in this direction are infinitely high. In a configuration close to a 
singular configuration joint velocities required to move in certain direction(s) are much above the hardware bounds on 
joint velocities, resulting in inaccurate motion. The workspace of an articulated manipulator (redundant or 
nonredundant) is filled with singularities at the workspace boundaries as well as inside the workspace. Singularities at 
the workspace boundaries are usually unavoidable; however, singularities inside the workspace, referred to as internal 
singularities, are avoidable for manipulators with redundant joints. Because an infinite number of joint configurations 
results in a given position and orientation of a redundant manipulator within its workspace, it is possible to choose a 
nonsingular joint configuration. However, in order to avoid singular configurations we need to know the conditions for 
singularity. 

When a manipulator is in a singular configuration, the determinant of JJ^ is zero [7]. Thus the joint coordinates 
that make the determinant of JJ T equal to zero would result in singular configurations. However, this condition 
involves an extremely complicated equation which is difficult to solve. The singularities of a seven-degree-of-freedom 
arm such as the LTM occur when the rank of the Jacobian J is less than six, implying that the arm is in a 
configuration in which the end-effector cannot be moved and rotated in a completely arbitrary direction. Because the 
Jacobian for the LTM is a 6 x 7 matrix, the rank of it may be determined by considering the determinant of all seven 6 
x 6 matrices that can be formed from the columns of J. Since this determination is extremely laborious, we utilize the 
following scheme. 

When joint 6 is either 0 or 180°, then joint 5 is collinear with joint 7. In this case the column 5 vector of J is 
equal to or the negative of the column 7 vector, which implies that the wrist is singular and cannot be moved to an 
arbitrary new orientation with just the use of the wrist joint angles. Thus, the task of finding the singularities has been 
broken into two parts. The singularities will be considered first for the case when joints 5 and 7 are not collinear, and 
then for the case when joints 5 and 7 are collinear. The Jacobian referred to the second coordinate frame J contains the 
following components: 



-34 c 2 s 3 c 4 

34S4 

-a4 s 3 c 4 

a4(s 2 S4+C2C3C4)+a2C2 

0 

a 4 c 3 c 4 

-34S2S3C4 

-(a2+a4C3C4) 

0 

' s 2 

0 

0 

0 

1 

0 

c 2 

0 

1 


■34 C 3 S 4 

0 

0 

0 

-848384 

0 

0 

0 

a4C4 

0 

0 

0 

s 3 

-C3 S 4 

C 3 C 4 S 5 +S 3 C 5 

(C3C 4 C5-S3S 5 )s 6 4C3S4C 6 

<3 

' S 3 S 4 

S 3 C 4 S 5" C 3 C 5 

( S 3 C 4 C 5 +C 3 S 5) S 6 +S 3 S 4 C 6 

0 

c 4 

S 4 S 5 

S 4 C 5S6' C 4 C 6 


( 25 ) 
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We now consider the following the cases: 

l. Joints 5 an d 7 A re No t Collingar ( N onsingular Wrist) 

Since the wrist is nonsingular, the LTM can be singular only when the first three rows of the Jacobian have a rank 
less than 3. This implies that the top left 3x4 submatrix Js of 2 J will have a rank less than 3 in a singular 
configuration. This sub-Jacobian is given by. 


Js 


-a4C2S3C4 a4S4 -a4S3C4 -340354 

a 4 ( s 2 s 4 +c 2 c 3 c 4 ) +a 2 c 2 0 a 4 c 3 c 4 ’34S3S4 

-a4S2S3C4 "(^2 +a 4 c 3 c 4) 0 


( 26 ) 


Denote by Jjj^ the Jacobian formed by the i*, j^, and k^ 1 columns of the Jacobian represented by Js. If the rank 
of Js is less than 3, then it follows that. 


del: ( J 123 ) = det(Jj24) = det (Jl34) = 0, det(J 234 ) = 0. (27) 

Based on the above conditions we obtain the singularities corresponding to a nonsingular wrist (see Table 3). Three 
singular configurations corresponding to a nonsingular wrist are shown in Fig. 2. 



Table 3. Singularities of the LTM (Nonsingular Wrist) 
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wi = atan( -a 2 /a*) , w 2 = atan( a 2 /a^ 

NPl — Not possible. Link 2 is coincident with link 4. 
NP2 — Not possible. Wrist pitch, 83 , is greater than -90. 


Fig. 2 Singular configurations corresponding to a nonsingular wrist. 


2. Joints 5 and 7 Are Collinear (Singular Wrist) 

Notice that with joints 5 and 7 collinear (0g = ±90°), the two 6-dimensional vectors formed by columns 5 and 7 of 
Jacobian 2 J are parallel, which corresponds to the wrist being in a singular position. Hence, for the LTM to have a 
singularity, only the sub-Jacobian given by the first six columns of 2 J need be considered. This sub-Jacobian will be 
represented by Jss and can be written in the following form: 


- 34 c 2 s 3 c 4 

8484 

-848304 

-040384 

0 

0 

a4(S2S4+C2 c 3 c 4) +a 2 c 2 

0 

840304 

-a4S 3 s 4 
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For the case under consideration, all the remaining singularities for the LTM can be determined by setting the 
determinant of the Jacobian Jss equal to zero. However, this leads to an equation for which the roots are difficult to 
determine As a result, at this time only the singularities will be found that correspond to the occurrence of two sets of 
collinear joint axes. Since all singularities were found for which joints 5 and 7 were not collinear, then it follows that 
any singularities that occur due to two sets of collinear joint axes must have one of that set of collinear joint axes due 
to joints 5 and 7 being collinear. Thus to determine if two sets of collinear joint axes can occur, it is first necessary to 
find all possible cases where sets of joint axes are collinear. Then it must be determined if those sets can physically 
exist when joints 5 and 7 are collinear. 

In the procedure for doing this we used the notation of Paul [6] in which the m* joint axis lies along the z axis of 
the (m-1) frame. Thus, if the z axis of frame n is collinear with the z axis of frame m, it means that joint axes m + 1 
and n + 1 are collinear. Let m T n denote the homogeneous transform which refers frame n of the LTM to frame m of 
the LTM. To be collinear it follows that m T n must be of the form 


m jn _ 


rll rl2 
i21 r22 


0 

L 0 


0 

0 


0 

0 

±1 

0 


0 

0 

p3 

1 


(29) 


In general, the m T n is of the form. 


mq-n _ 


(a) : rl3 = 0, 

(b) : r23 = 0, 


' rll 

rl2 

rl3 

Pi 


i21 

i22 

r23 

p2 


r31 

r32 

p33 

p3 


. 0 

0 

0 

1 J 


following seven 

relations must be satisfied. 

= o. 


(e): 

r33 = 

±1. 

= o. 


(0: pi = 

0, 


(30) 


(31) 


(g): p2 = 0. 


Notice thatEq. (31) represents a set of dependent equations. Only Eqs. (31c), (31d), (31f), and (31g) are independent; 
however, the other equations help in the algebraic manipulation. Based on the above conditions, we obtain the 
singularities of the LTM when the wrist is in a singular configuration (Table 4). Figure 3 shows three of die singular 
configurations corresponding to a singular wrist. Including the singularities of both cases, that is, singular and 
nonsingular wrist, we obtain the singularities of the LTM shown in Table 5. 

Table 4, Singularities of the LTM (Singular Wrist) 
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Table 5. Singularities of the LTM (Singular and Nonsingular Wrist) 
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Fig. 3 Three configurations corresponding to a singular wrist. 
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To avoid the singular configurations shown in Table 5, we may optimize the following performance criterion: 

H(0) = k2Sin^02 + l^cos^Gj + l^sin^ + kgcos^Gg , (32) 

where the k; are weighting factors that may be chosen based on the range of the joint angle and the distance the joint 
angle is from its desired value. Inspection of Eq. (32) and Table 5 shows that if H(0) is minimized, then joints 4 and 2 
will tend to move toward 0° while joints 3 and 6 will tend to move toward ±90°. 

6. Real-Time Implementation and Simulation Results 

The robotic control scheme for the LTM is being implemented on a 16-MHz VME bus/Motorola 68020 
microprocessor. The software is written in C language. Figure 4 is a block diagram of implementation of the 
kinematic optimization scheme. Control loops are closed around the joint servos, and the optimizing inverse 
kinematics algorithm is implemented in an open-loop fashion. The complete algorithm runs at 100 Hz, which includes 
the optimizing inverse kinematics, forward kinematics, joint-to-motor transformation calculations, and joint velocity 
and position limit checking. 



Fig. 4 Real-time implementation block diagram. 

Graphical simulations to test the control software were performed for different cases. In each case the LTM end- 
effector follows a specified straight-line trajectory while maintaining a fixed orientation . In the first case, the 
performance criterion H(0) in Eq. 24 is minimized so that the LTM avoids running into joint limits. In the second 
case, singularities are avoided by optimizing performance criterion H(0) in Eq. 32. Comparison is made in each case 
with the joint trajectories resulting from the least-norm solution, which does not utilize the null space of the Jacobian 
to optimize a performance criterion. 

Simulation results presented in Figures 5 and 6 are for the case when the performance criterion is optimized to 
avoid joint angle limits. Each figure shows the LTM trajectory along with a plot of joint angles as a function of time. 
In Fig. 5, only the least-norm solution is used to follow the desired end-effector trajectory. In this case joint 5 hits its 
lower limit before the end point is reached. Figure 6 demonstrates the use of redundancy to avoid the limits on joint 
angles. In this case the LTM reaches the desired end point along a specified trajectory without reaching a joint limit. 

Figures 7 and 8 present the case when the performance criterion is optimized to avoid high joint velocities due to 
an internal singularity. The LTM is started in a near singular configuration in both figures. The least-norm solution 
shown in Fig. 7 produces high joint velocities and, therefore, the LTM is commanded to stop; however, Fig. 8 shows 
that if the null space of the Jacobian is utilized to avoid singularities, the desired end point is reached without getting 
too close to the singular configuration, thus avoiding high joint velocities. 
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Fig. 7 End-effector motion along a straight line with a fixed orientation . 
(Least-norm solution-reaches velocity limit) 
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Fig. 8 End-effector motion along a straight line with a fixed orientation . 
(Redundancy utilized to avoid singularities) 
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7. Conclusions 


A computationally efficient, robotic control scheme for the seven-degree-of-freedom LTM was presented. This 
scheme determines the joint velocities required to follow a specified end-effector trajectory while optimizing a given 
performance criterion using the gradient projection method. LTM kinematics was analyzed to determine its internal 
singularities. Performance criteria to avoid joint angle limits and singularities were obtained. Feasibility and 
effectiveness of the control scheme were demonstrated by simulations to avoid joint angle limits and singularities. 
Real-time implementation of the control scheme is in progress. Future work includes the use of redundancy to avoid 
obstacles and minimize joint torques, simultaneous optimizations of multiple performance criteria, and extension of the 
robotic control scheme to telerobotic control with force reflection. 
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